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ABSTRACT 

This paper presents a simulation analysis on kinematics and control of a robot arm using a Proportional 
integral derivative (PID) controller. Robotic arms are from a series of lightweight, fast, easy to program, flexible, and safe 
robotic arms with 6 degrees of freedom. Moreover, a kinematics modelling of the robot arm which is very important for 
any application has been presented. Furthermore, the robot arm is simulated and analysis using Matlab/Simulink from 
the mechanical model in Solid Works. Simulation results will help the designers and engineers to evaluate the chosen and 
designed model. 
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1. INTRODUCTION 

Robots are used in a wide range of industrial applications and robotics technology is likely to become the 
high technology field of the 21st century [1, 2]. Robots were initially applied to jobs that were hot, heavy and 
hazardous such as die casting, forging, and spot welding. 6-axis robots can be widely used in carrying, assembly, 
welding, spraying, winding, motor assembly and other industrial sites which alleviate the current shortage of 
industrial workers and can dramatically reduce the quality of workers because of differences in the impact on 
product quality [3]. 

A six revolute joint robot configuration with 6 D. O. F is generally wellDsuited for small parts insertion 
and assembly, like electronic components. Although the final goal is to design and manufacture real robotics, it is 
very useful to perform simulations prior to investigations with real robots. Simulations are easier to setup, less 
expensive, faster and more convenient to use. It allows better design exploration and helps you enhance your final 
real robot by selecting suitable parameters for the system you want to design [4]. There are many control techniques 
used to control a robot arm. The most used ones are the PID control, optimal control, adaptive control and robust 
control. “There are many kinds of controllers that can be used to cause a designed robot arm to move along a 
desired trajectory” [5]. The simplest which we used in this paper to control the robot arm is the PID controller. 

Ata et al. [6] show a model a two-link flexible manipulator by Bernoulli-Euler theory. A dynamic 
modelling technique has been addressed by Subudhi and Morris [7] developed multiple flexible link-joint systems 
using Euler-Lagrange formulation. Swern & Tricamo [8] designed a control algorithm that eliminates the constraint 
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forces supplying a position correction to each arm. A control model has also been proposed by Khemaissia [9] introduced 
goal-directed multi joint-arm movement using a hybrid neuro-genetic algorithm. Colbaugh et al [10] showed a strategy 
aims at adaptively generating the position set points for the standard robot controllers, without requiring knowledge of both 
manipulator and payload model parameters and dynamics. Some more researchers also have studied the dynamic 
formulation of flexible manipulators using either Lagrangian formulation [11-14] or Euler formulations [15]. However, 
going through the literature it has been observed that validation of the analytic models for the flexible manipulators is 
difficult and often becomes impossible. Moreover, control of such manipulators is a complex problem. Quite a few 
researchers have tried to control fiexible manipulators using different control algorithms such as Proportional Derivative 
Control Law [16], Robust Control Law [17], Neuro-Fuzzy-based control law [18], etc. However, there are some inherent 
problems existing with those control laws. In this paper, the 6 DOF robot arm has been studied. The direct and inverse 
kinematics has been obtained by calculation [19]. Then the dynamic model of the system has been extracted by the 
Lagrange method that is very powerful in modeling the developed mechanical systems. In this paper, a PID controller has 
been designed for 6 DOF robotic which give the simple and fast way to control the robot arm. 

2. METHODOLOGY 

2.1 System Modelling 

In accomplishing this paper, the scope of the work has been divided into a few parts. The first part is to design 
CAD model of 6 DOF robot arm. The second part is to design the PID controller for the robot arm for comparison purpose. 
The third part is to perform simulation using MATLAB/Simulink. The last part is to analyse the output performance of 
both controllers. The research methodology flow chart is shown in Figure 1. 



Figure 1: Flow chart for Design of Robotic Arm 

2.2 Design of Arm Robotic 

First each part of robotic arm designed in solid works and these whole parts are assembled as per our requirement. 
The names of the parts are base, link 1, link 2, link 3 and link 4. As shown in below Figure 2. 
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Base Link 1 Link 2 

1 I 

Link 3 link4 robotics arm 

Figure 2: Design of Base, Link 1, Link 2, Link 3, link 4 and Robotics Arm in Solid Works 

2.3 Kinematic Equations of Robot Arm 

Kinematics is the relationships between the positions, velocities, and accelerations of the links of a manipulator, 
where a manipulator is an arm. Robot kinematics are two types these are forward kinematics and inverse kinematics; here 
forward kinematics is used. We need to consider the transformation relations between joint n and n+1 that are in the two 
adjacent coordinate systems while defining the 4 important parameters by the D-H method 

• ai = distance from Zi to Zi+1 measured along Xi 

• ai = angle from Zi to Zi+1 measured along Xi 

• di = distance from Xi-1 to Xi measured along Zi 

• 0i = angle from Xi-1 to Xi measured along Zi 
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Axis i - 1 Axis i 



Figure 3: Denavit - Hartenberg General Frame Assignment 
2.3.1 Forward Transformation Matrices 

Finding the link parameters and joint parameters of the robotic arm, based on that parameters calculate the 
transformation matrices of each joint present in the robotic arm. After getting these matrices and add these matrices based 
on the Denavit-Hartenberg parameters. Link transformation matrices for robotic arm 

• Rotate the frame Xi-lYi-lZi-1 about the Zi-1 axis by an angle 0i. After this rotation, the current Xi-1 axis will be 
parallel to the Xi axis. 

• Translate the frame Xi-lYi-lZi-1 along the Zi-1 axis by diunits so that the current Xi-1 axis will be aligned with 
the Xi axis. 

• Translate the frame Xi-lYi-lZi-1 along the Xi axis byai units such that the current Xi-1 axis will coincide with 
the Xi axis. 


• Rotate the frame Xi-lYi-lZi-1 about the Xi axis by an angle ai. After that, the current frame Xi-lYi-lZi- 
lcoincides with the frame XiYiZi. 


Table 1: The Transformation Matrix 
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Where: 

Sl: Sin @1 
Cl: Cos @1 

The transformation matrix from robot base to robot actuator 0A6 is expressed as. 


yi. o x a x p x 


ny o y a y p y 
n z o z a z p z 


0A6 = OAl 1A2 2A3 3A4 4A5 5A6 = L J 

nx= C1[C23(C4C5C6-S4S6) - S23S5C6] + S1(S4C5C6 + C4S6) 
ny= S1[C23(C4C5C6 - S4S6) - S23S5C6] - C1(S4C5C6 + C4S6) 
nz= S23(C4C5C6 - S4S6) + C23S5C6 

ox= C1[-C23(C4C5S6 + S4C6) + S23S5S6] + S1(-S4C5S6 + C4C6) 

oy= -S23[-C23(C4C5S6 + S4C6) + S23S5S6] - C1(-S4C5S6 + C4C6) 

oz= -S23 (C4C5S6 + S4C6) - C23S5S6 

ax= C1(C23C4S5 + S23C5) + S1S4S5 

ay= S1(C23C4S5 + S23C5) - C1S4S5 

az= S23C4S5 - C23C5 

Px= Cl[aO + alC2 + a2C23 + d3S23 + 14(C23C4S5 + S23C5)] + d4SlS4S5 
Py= Sl[aO + alC2 + a2C23 + d3S23 + d4(C23C4S5 + S23C5)] - d4ClS4S5 
Pz= alS2 + a2S23 - d3C23 + d4(S23C4S5 - C23C5). 
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2.3.2 Inverse Kinematics 

The joints of 6-axis robot as shown in Figure 2, the position of sixth arm terminal is and the position of fifth joint 


is 


n. 

o, 

a, 

q 

Oy 

Oy 

Oy 

a 

n 

O: 

a 

Q 

0 

0 

0 

1 


0A4= OAl 1A2 2A3 3A4 = L 
Based on equation (1) and (2), the relationship between Px, Py, Pz and Qx Qy Qz can be expressed as: 
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Based on element (3,4),^ can be expressed as below 
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Based on element (1,4) and (2,4), the following equations are obtained. 
(C 2 C ± Q x + C 2 S^Qy + S 2 Q z — C 2 Qq = d 2 S 2 + a 2 C 2 + a^ 


(C 2 CiV x + 

1 ~S 2 C ± Q x — S 2 s t 

So, 6 3 can be expressed as 


x *^ 2 j i Qy "f C 2 Q z + S 2 a^ — d 3 C 3 + a 2 S 3 


6 3 = 2 tan 1 1 —- 


k 2 +k 3 
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K 4 — 2d^c^3 
K 2 = 2 a 1 a 3 

[K 3 = Qx + Qy + Qz - ^QxaoC^ - ZQyUoS^ + a 0 2 - a ± 2 - a 2 2 - d 3 2 

Based on equations (3), 0 2 can be expressed as below. 
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Based on element (3,3),0 5 can be expressed as 0 S = arccos + a^S^s — a z C 23 

• 04 

Base on element(l,3) and (2,3) of equation (4), 0 4 can be expressed as below. 
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Base on element(2,l) and (2,2) of equation(5), d 6 can be expressed as below. 
0 6 = atan 2(S 6 , C 6 ) 

r _ n xCiC23 +n ySiS23+n z C23 
Ce ~ % 

c _ 0x C l S 23 +0 y S l S 23 + 0 zC23 
6 “ 

2.4 Dynamics for Arm Robotics 

The arm robotics' dynamic equations have the general form of: 

M (q)q + c (q,q)q + 5(q) = u 
Where : 


M yqj: is the symmetric positive definite mass inertia matrix of the system 
C (q, q): is the matrix of Coriolis and centrifugal terms 

g ^y. is the vector of gravity terms and u is the input vector 
The inverse dynamic has the form: 

q= M_1 (q) (M-c(q,q)q-5(q) 

The matrix M (q) would be simply calculated as [19] 

M (q) = E?=i +& l R l I l RlJ Wl )] 

Where: 


Jvi’Jwi : are the linear and angular part of the Jacobian matrix J h respectively. 

For deriving the matrix C (q, q) it would be useful to know the passivity property of robotic manipulators which is 

the result of the skew-symmetry property of the matrix M (q^ — 2C (q, q). For reaching this property the elements of the 
matrix G^must be derived from the elements of the inertia matrix ra^via the following formula [19], 


n Vm ik 
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Finally, the elements of the gravity vector gt(q) [19], 
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Having M (q), C (q, q) and g t (c/) completes the dynamical model development. 


3. SIMULATION OF THE ROBOT ARM 

3.1 Desgin Controller Circuit for Robotics Arm 

By study the mathematical models of the kinematics and dynamics in the previous section have been used to 
develop the Matlab model for the robot here. By CAD export robotic arm converted into simulink circuit block in 
MATLAB/Simulink as shown in below figure. 



Figure 4: Basic Simulink Model of Robotic Arm 


3.1.1 Design PID Control for Robotics Arm 

PID (Proportional Integrate Derivative) controller is considered the most widely used control technique in control 
applications. A high number of applications and control engineers had used the PID controller in daily life. On the other 
hand, many research papers, number of master and doctoral theses and books had highlighted this subject. PID control 
offers an easy method of controlling a process by varying its parameters. PID works well in industrial applications such as 
in slow industrial manipulators where large components of joint inertia are added by actuators. Since the invention of PID 
control in 1910, and Ziegler-Nichols’ (ZN) tuning method in 1942 [20] and [21], PID controllers became one of the 
dominant and popular issues in control theory due to the simplicity of implementation, the ease of designing, and the 
ability to be used in a wide range of applications [22]. Moreover, they are available at low cost. Finally, it provides robust 
and reliable performance for most systems if the parameters are tuned properly. However, the PID controller has its own 
limitation; the PID performances can give only satisfactory performance if the requirement is reasonable and the process 
parameters variation are limited. 

3.2 Circuit Model of Robotic Arm 

The robotic arm a controller block required. So attach the controller blocks and reference blocks to that robotic 
arm by MATLAB/Simulink as shown in below figure 5. 

In this circuit model contains reference angle trajectory, reference angle test vector, controller, robotic arm blocks 
and finally scope are presented. In this reference angle trajectory, reference angle test vector block are used to given the 
joint angles to the robotic arm. Controller block controls the dc motors present in the robotic arm for this purpose we use 
PID (Proportional Integrate Derivative) controllers. In this PID controller gives an error of ±30 error (Joint angle error). 
Based on that robotic arm moves and are as shown in following below Figure 6 to Figure 9. 
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Figure 6: Reference Tracking 
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Figure 7: Controller Effort 
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Plot Step ▼ Response Input disturbance rejection ▼ / Show block response 
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Figure 8: Input Disturbance Rejection 
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Figure 9: Output Disturbance Rejection 
4. SIMULATION RESULTS AND DISCUSSIONS 


View Simulation Model Help 

y k %\*]& ► 
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Figure 10: Robotic Arm in Simulation 


Comparison of the Angluer velocity: The control input, forces the robotic manipulators to track the desired 
trajectories. Figure 11 shows the torque performance in PID controller. According to the following graph, PID controller 
has steady stable torque performance in second, third and fourth joints but it has oscillation in the first joint. In the control 
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forces, smaller amplitude means less energy. According to Figure 11, the amplitude of the control forces in first joint of 
PID controller is much larger than the other joints. 



Figure 11: Simulation Result Waveforms of Robotic Arm 

5. CONCLUSIONS 

The six-axis Robot arm in MATLAB/SIMULINK is modelled based computer program, which can be used to 
simulate the functions of a real robotic manipulator in terms of design parameters, movement, and control. In this paper, 
after extract the dynamic and kinematics formulations, these formulations are model and implemented by 
MATLAB/SIMULINK. After that, a SimMechanics model of robotics arm was developed with the parameter values 
obtained from the manufacturer material. At the end, a cross-validation of the models was performed by using the 
mathematical model for the control of Simmechanics model. Through simulation, the accuracy of the mathematical model 
was explained. 
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